Node / meshcore / MeshCore / files / src / helpers / esp32 / ESPNOWRadio.cpp

Displaying Raw • Download

Tff7b72#Tff7b72include T8b949e"ESPNOWRadio.h"

Tff7b72#Tff7b72include T8b949e<esp_now.h>

Tff7b72#Tff7b72include T8b949e<WiFi.h>

Tff7b72#Tff7b72include T8b949e<esp_wifi.h>

Tff7b72static Tffa657uint8_t Te6edf3broadcastAddressTb4b4b4[Tb4b4b4] Tff7b72= Tb4b4b4{T79c0ff0xFFTb4b4b4, T79c0ff0xFFTb4b4b4, T79c0ff0xFFTb4b4b4, T79c0ff0xFFTb4b4b4, T79c0ff0xFFTb4b4b4, T79c0ff0xFFTb4b4b4}Tb4b4b4;

Tff7b72static Te6edf3esp_now_peer_info_t Te6edf3peerInfoTb4b4b4;

Tff7b72static Tff7b72volatile Tffa657bool Te6edf3is_send_complete Tff7b72= Tffa657falseTb4b4b4;

Tff7b72static Te6edf3esp_err_t Te6edf3last_send_resultTb4b4b4;

Tff7b72static Tffa657uint8_t Te6edf3rx_bufTb4b4b4[T79c0ff256Tb4b4b4]Tb4b4b4;

Tff7b72static Tffa657uint8_t Te6edf3last_rx_len Tff7b72= T79c0ff0Tb4b4b4;

T8b949e// callback when data is sent

Tff7b72static Tffa657void Td2a8ffOnDataSentTb4b4b4(Tff7b72const Tffa657uint8_t Tff7b72*Te6edf3mac_addrTb4b4b4, Te6edf3esp_now_send_status_t Te6edf3statusTb4b4b4) Tb4b4b4{

Te6edf3is_send_complete Tff7b72= Tffa657trueTb4b4b4;

Te6edf3ESPNOW_DEBUG_PRINTLNTb4b4b4(Ta5d6ff"Ta5d6ffSend Status: %dTa5d6ff"Tb4b4b4, Tb4b4b4(Tffa657intTb4b4b4)Te6edf3statusTb4b4b4)Tb4b4b4;

Tb4b4b4}

Tff7b72static Tffa657void Td2a8ffOnDataRecvTb4b4b4(Tff7b72const Tffa657uint8_t Tff7b72*Te6edf3macTb4b4b4, Tff7b72const Tffa657uint8_t Tff7b72*Te6edf3dataTb4b4b4, Tffa657int Te6edf3lenTb4b4b4) Tb4b4b4{

Te6edf3ESPNOW_DEBUG_PRINTLNTb4b4b4(Ta5d6ff"Ta5d6ffRecv: len = %dTa5d6ff"Tb4b4b4, Te6edf3lenTb4b4b4)Tb4b4b4;

Te6edf3memcpyTb4b4b4(Te6edf3rx_bufTb4b4b4, Te6edf3dataTb4b4b4, Te6edf3lenTb4b4b4)Tb4b4b4;

Te6edf3last_rx_len Tff7b72= Te6edf3lenTb4b4b4;

Tb4b4b4}

Tffa657void Td2a8ffESPNOWRadio::initTb4b4b4(Tb4b4b4) Tb4b4b4{

T8b949e// Set device as a Wi-Fi Station

Te6edf3WiFiTb4b4b4.Te6edf3modeTb4b4b4(Te6edf3WIFI_STATb4b4b4)Tb4b4b4;

T8b949e// Long Range mode

Te6edf3esp_wifi_set_protocolTb4b4b4(Te6edf3WIFI_IF_STATb4b4b4, Te6edf3WIFI_PROTOCOL_LRTb4b4b4)Tb4b4b4;

T8b949e// Init ESP-NOW

Tff7b72if Tb4b4b4(Te6edf3esp_now_initTb4b4b4(Tb4b4b4) Tff7b72!Tff7b72= Te6edf3ESP_OKTb4b4b4) Tb4b4b4{

Te6edf3ESPNOW_DEBUG_PRINTLNTb4b4b4(Ta5d6ff"Ta5d6ffError initializing ESP-NOWTa5d6ff"Tb4b4b4)Tb4b4b4;

Tff7b72returnTb4b4b4;

Tb4b4b4}

Te6edf3esp_wifi_set_max_tx_powerTb4b4b4(T79c0ff80Tb4b4b4)Tb4b4b4; T8b949e// should be 20dBm

Te6edf3esp_now_register_send_cbTb4b4b4(Te6edf3OnDataSentTb4b4b4)Tb4b4b4;

Te6edf3esp_now_register_recv_cbTb4b4b4(Te6edf3OnDataRecvTb4b4b4)Tb4b4b4;

T8b949e// Register peer

Te6edf3memcpyTb4b4b4(Te6edf3peerInfoTb4b4b4.Te6edf3peer_addrTb4b4b4, Te6edf3broadcastAddressTb4b4b4, T79c0ff6Tb4b4b4)Tb4b4b4;

Te6edf3peerInfoTb4b4b4.Te6edf3channel Tff7b72= T79c0ff0Tb4b4b4;

Te6edf3peerInfoTb4b4b4.Te6edf3encrypt Tff7b72= Tffa657falseTb4b4b4;

Te6edf3is_send_complete Tff7b72= Tffa657trueTb4b4b4;

T8b949e// Add peer

Tff7b72if Tb4b4b4(Te6edf3esp_now_add_peerTb4b4b4(Tff7b72&Te6edf3peerInfoTb4b4b4) Tff7b72=Tff7b72= Te6edf3ESP_OKTb4b4b4) Tb4b4b4{

Te6edf3ESPNOW_DEBUG_PRINTLNTb4b4b4(Ta5d6ff"Ta5d6ffinit successTa5d6ff"Tb4b4b4)Tb4b4b4;

Tb4b4b4} Tff7b72else Tb4b4b4{

T8b949e// ESPNOW_DEBUG_PRINTLN("Failed to add peer");

Tb4b4b4}

Tb4b4b4}

Tffa657uint32_t Td2a8ffESPNOWRadio::getRngSeedTb4b4b4(Tb4b4b4) Tb4b4b4{

Tff7b72return Te6edf3millisTb4b4b4(Tb4b4b4) Tff7b72+ Te6edf3intIDTb4b4b4(Tb4b4b4)Tb4b4b4; T8b949e// TODO: where to get some entropy?

Tb4b4b4}

Tffa657void Td2a8ffESPNOWRadio::setTxPowerTb4b4b4(Tffa657uint8_t Te6edf3dbmTb4b4b4) Tb4b4b4{

Te6edf3esp_wifi_set_max_tx_powerTb4b4b4(Te6edf3dbm Tff7b72* T79c0ff4Tb4b4b4)Tb4b4b4;

Tb4b4b4}

Tffa657uint32_t Td2a8ffESPNOWRadio::intIDTb4b4b4(Tb4b4b4) Tb4b4b4{

Tffa657uint8_t Te6edf3macTb4b4b4[T79c0ff8Tb4b4b4]Tb4b4b4;

Te6edf3memsetTb4b4b4(Te6edf3macTb4b4b4, T79c0ff0Tb4b4b4, Tff7b72sizeofTb4b4b4(Te6edf3macTb4b4b4)Tb4b4b4)Tb4b4b4;

Te6edf3esp_efuse_mac_get_defaultTb4b4b4(Te6edf3macTb4b4b4)Tb4b4b4;

Tffa657uint32_t Te6edf3nTb4b4b4, Te6edf3mTb4b4b4;

Te6edf3memcpyTb4b4b4(Tff7b72&Te6edf3nTb4b4b4, Tff7b72&Te6edf3macTb4b4b4[T79c0ff0Tb4b4b4]Tb4b4b4, T79c0ff4Tb4b4b4)Tb4b4b4;

Te6edf3memcpyTb4b4b4(Tff7b72&Te6edf3mTb4b4b4, Tff7b72&Te6edf3macTb4b4b4[T79c0ff4Tb4b4b4]Tb4b4b4, T79c0ff4Tb4b4b4)Tb4b4b4;

Tff7b72return Te6edf3n Tff7b72+ Te6edf3mTb4b4b4;

Tb4b4b4}

Tffa657bool Td2a8ffESPNOWRadio::startSendRawTb4b4b4(Tff7b72const Tffa657uint8_tTff7b72* Te6edf3bytesTb4b4b4, Tffa657int Te6edf3lenTb4b4b4) Tb4b4b4{

T8b949e// Send message via ESP-NOW

Te6edf3is_send_complete Tff7b72= Tffa657falseTb4b4b4;

Te6edf3esp_err_t Te6edf3result Tff7b72= Te6edf3esp_now_sendTb4b4b4(Te6edf3broadcastAddressTb4b4b4, Te6edf3bytesTb4b4b4, Te6edf3lenTb4b4b4)Tb4b4b4;

Tff7b72if Tb4b4b4(Te6edf3result Tff7b72=Tff7b72= Te6edf3ESP_OKTb4b4b4) Tb4b4b4{

Te6edf3n_sentTff7b72+Tff7b72+Tb4b4b4;

Te6edf3ESPNOW_DEBUG_PRINTLNTb4b4b4(Ta5d6ff"Ta5d6ffSend successTa5d6ff"Tb4b4b4)Tb4b4b4;

Tff7b72return Tffa657trueTb4b4b4;

Tb4b4b4}

Te6edf3last_send_result Tff7b72= Te6edf3resultTb4b4b4;

Te6edf3is_send_complete Tff7b72= Tffa657trueTb4b4b4;

Te6edf3ESPNOW_DEBUG_PRINTLNTb4b4b4(Ta5d6ff"Ta5d6ffSend failed: %dTa5d6ff"Tb4b4b4, Te6edf3resultTb4b4b4)Tb4b4b4;

Tff7b72return Tffa657falseTb4b4b4;

Tb4b4b4}

Tffa657bool Td2a8ffESPNOWRadio::isSendCompleteTb4b4b4(Tb4b4b4) Tb4b4b4{

Tff7b72return Te6edf3is_send_completeTb4b4b4;

Tb4b4b4}

Tffa657void Td2a8ffESPNOWRadio::onSendFinishedTb4b4b4(Tb4b4b4) Tb4b4b4{

Te6edf3is_send_complete Tff7b72= Tffa657trueTb4b4b4;

Tb4b4b4}

Tffa657bool Td2a8ffESPNOWRadio::isInRecvModeTb4b4b4(Tb4b4b4) Tff7b72const Tb4b4b4{

Tff7b72return Te6edf3is_send_completeTb4b4b4; T8b949e// if NO send in progress, then we're in Rx mode

Tb4b4b4}

Tffa657float Td2a8ffESPNOWRadio::getLastRSSITb4b4b4(Tb4b4b4) Tff7b72const Tb4b4b4{ Tff7b72return T79c0ff0Tb4b4b4; Tb4b4b4}

Tffa657float Td2a8ffESPNOWRadio::getLastSNRTb4b4b4(Tb4b4b4) Tff7b72const Tb4b4b4{ Tff7b72return T79c0ff0Tb4b4b4; Tb4b4b4}

Tffa657int Td2a8ffESPNOWRadio::recvRawTb4b4b4(Tffa657uint8_tTff7b72* Te6edf3bytesTb4b4b4, Tffa657int Te6edf3szTb4b4b4) Tb4b4b4{

Tffa657int Te6edf3len Tff7b72= Te6edf3last_rx_lenTb4b4b4;

Tff7b72if Tb4b4b4(Te6edf3last_rx_len Tff7b72> T79c0ff0Tb4b4b4) Tb4b4b4{

Te6edf3memcpyTb4b4b4(Te6edf3bytesTb4b4b4, Te6edf3rx_bufTb4b4b4, Te6edf3last_rx_lenTb4b4b4)Tb4b4b4;

Te6edf3last_rx_len Tff7b72= T79c0ff0Tb4b4b4;

Te6edf3n_recvTff7b72+Tff7b72+Tb4b4b4;

Tb4b4b4}

Tff7b72return Te6edf3lenTb4b4b4;

Tb4b4b4}

Tffa657uint32_t Td2a8ffESPNOWRadio::getEstAirtimeForTb4b4b4(Tffa657int Te6edf3len_bytesTb4b4b4) Tb4b4b4{

Tff7b72return T79c0ff4Tb4b4b4; T8b949e// Fast AF

Tb4b4b4}